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ABSTRACT 

This paper addresses the problem of inverse dynamics for articulated 
flexible structures with both lumped and distributed actuators. This problem 
arises, for example, in the combined vibration minimization and trajectory con- 
trol of space robots and structures. A new inverse dynamics scheme for com- 
puting the nominal lumped and distributed inputs for tracking a prescribed tra- 
jectory is given. 


1. Introduction 

Inverse dynamics is an important problem in the control of articulated flexible structures 
such as space stations and manipulators. A solution for the nonredundant lumped actuator case 
has been provided by Bayo et. al., [1] and Book, [2]. This method produces bounded inputs 
which move a reference point on the structure along a desired trajectory. The inputs are neces- 
sarily non-causal when the structure dynamics arc nonminimum phase. Elastic deformation 
which may cause vibration of the structure is also determined by the trajectory; our goal is to 
minimize such vibrations. The viability of distributed actuators for the control of structural 
vibrations, [3] , [4] and [5] , has motivated their use here for trajectory tracking. 

Trajectory tracking of the structure can be accomplished by the use of the joint actuators 
alone [6] and in this sense the distributed actuators are redundant. We introduce the concept of 
using the extra actuation available through the distributed actuators in the structure to not only 
satisfy the trajectory tracking constraint but also minimize the accompanying clastic displace- 
ments during the motion. To obtain these new feedforward inputs, the inverse dynamics 
method suggested in [ 1 ] is extended to cover cases of redundantly- actuated structures. This use 
of distributed actuators in feedforward for end effector trajectory control is contrasted with the 
use of only the joint actuators in feedforward in an example of a flexible two link truss struc- 
ture with distributed piezo-electric actuators to verify the efficacy of the proposed method. 

The remainder of the paper is organized in the following format. The modeling of flexi- 
ble structures with joint and distributed actuators, the formulation of the problem and its solu- 
tion arc presented in Section 2. Section 3 deals with an application of the proposed method to 
the example of a two link flexible truss. The discussions and conclusions are presented in sec- 
tion 4. 
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2. Formulation 

The solution to the general multi-link inverse dynamics problem involves studying an 
individual link in the chain, coupling the equations of the individual links, and then recursively 
converging to the desired actuator inputs and corresponding displacements. This approach is 
presented below, beginning with a single link. 


2.1 Equation of motion of a single link 

To simplify the equations, we present the equations for a link with a revolute joint. The 
flexible link depicted in figure 1 forms part of a multi-link system. The link is shown with a 
revolute joint, however the formulation remains identical for a link with translational joint. The 
elastic deflections in the structure are defined with respect to a nominal position characterized 
by a moving frame whose origin coincides with the location of the hub of the link. The nomi- 
nal motion of this frame is prespecified by its angular velocity CO/, , angular acceleration a h and 
the translational motion of its origin. The above definition of the elastic displacements with 
respect to this nominal frame permits the linearization of the problem from the outset. Incor- 
porating the kinematic model followed by Naganathan and Soni [7] in a finite element model 
(FEM), the equations of motion for a single link at any time t can be written as [1] 

Mi + Jc + C c (oi h ) j z + + K c (a. h ,(j) h ) j z = B t T + B p V p + F. (2.1) 


Where z is an R n vector of the finite element degrees of freedom. M and K belong to R nxn 
and arc the conventional finite element mass and stiffness matrices respectively; C c and 
K c e R nxn and are the time varying Coriolis and centrifugal stiffness matrices, respectively. 
The R nxn matrix C represents the internal viscous damping of the material. T is the unknown 
joint actuation. F e R n contains the reactions at the end of the link, and the known forces 
produced by the rotating frame effect. The distributed actuator inputs at time t arc The 
equivalent nodal forces at the FEM degrees of freedom due to the distributed actuators are 
represented by V p , a R Hp vector, where np is the number of distributed actuator inputs. B r and 
B p are constant matrices of dimensions R n and R nxn P , respectively. The set of finite element 
equations (2.1) may be partitioned as follows 
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where 0 A is the elastic rotation of the hub, z, is the clastic deflection at the tip in the y direc- 
tion, and the other n-2 finite element degrees of freedom are included in the vector z,. The 
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force vector, F , and the B p and B T matrices are also partitioned similarly. 

2.2 Minimization Objective 

The requirement is to accurately track the end effector of the link along the given nomi- 
nal trajectory without overshoot and residual vibrations. Additionally we also seek to minimize 
the ensuing structural vibrations during this motion by minimizing J(T,V p ), a measure of elas- 
tic deflections in the structure defined as follows 

oo 

J(T,V p ) = j z(t) T z(t)dt. (2.3) 

— oo 

Mathematically the objective can be stated as 

min J(T,V p ). (2.4) 

<jy P ) € t 

Where f is the set of all pairs of stable joint torque and distributed actuator inputs that when 
used to actuate the system defined by equation (2.2) yields z,(r) = 0 for all t. 


23 Solution Methodology 

An iterative scheme is described below for each link. Equation (2.2) can be rewritten as 
M'z + Cz + Kz= B t T+ B p V p + F - C c (Q) h ) z - K c (a h ,(O h ) z (2.5) 


where the time dependent Coriolis and centrifugal terms are kept on the RHS of the equation. 
The iteration procedure starts with the absence of the last two terms involving C c and K c in 
the right hand side. Then, the system of equations can be transformed into independent sets of 
simultaneous complex equations by means of the Fourier transform. For each of the evaluation 
frequency 55, equation (2.5) becomes 
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where the bar stands for the Fourier transform, and F represents the known forcing terms. 
After the first iteration it will also include the updated contributions from the Coriolis and cen- 
trifugal terms appearing in the RHS of equation (2.5). For any 55 * 0, the matrix 


H = 


M + —C - 4 zK 
i 55 5T 


(2.7) 


is a complex, symmetric and invertible matrix. For 55 = 0 the system undergoes a rigid body 
motion and H - M which is the positive definite invertible mass matrix. Let G = H~ x . Then 
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ihe above equation can be re-written as 
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The condition that the tip should follow the nominal motion is equivalent to z, = 0 for all 55. 
This induces a relationship between the joint actuation and the distributed actuator inputs and is 
obtained from the last row of the previous equation. 
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Sub stituti ng this expression for the input hub torque in equation (2.8) and using the property 
~d r z 9 

that — - = -55 z yields 

dt 2 



z = — 7 (AV p +B). 
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Where 

A = [~Gth~ l GB T (G lh G ti G„) + G] B p 

(2.11) 

and 

B = [-G,/, -1 GB T (G lh G ti G lt ) + G]F . 

(2.12) 


Next we determine V^~. Using Parseval’s theorem, minimizing J(T,V p ) in equation (2.4) is 
equivalent to minimizing ||F||| at each 55. This is a standard least squares approximation prob- 
lem [8] and results in the following solution for the distributed actuator inputs, 
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where X, U and V define the standard singular value decomposition of A as follows 

V-AV = «]. (2.14) 

Where the conjugate transpose matrix operator is denoted by *. In addition if A has rank np , 
which is the number of distributed actuator inputs, then the least squares approximation yields 

\r=-(A'Ar'A*B . ( 2 . 15 ) 


94 



A sufficient and necessary condition for A to have rank np is given next. 

Lemma 

rank [A ] = np if and only if rank [5 r j ] = np+ 1 (2.16) 

Proof 

Rank [B T ] = 1 => rank lGB T (G lh G u G,,)] = 1 , 

=>rank A = \-G ih ~ x GB T (G lh G ti G„) + G ] J > n-1. 

Since B r = [1 0 0]* , it is easy to see that the null space of A is the span of [1 0 0]* . Hence 
rank A is n-\. Noting that A = A B p , the lemma follows easily. □ 

The above lemma requires that all the columns of the input matrices B T and B p be indepen- 
dent. This is computationally more efficient than checking the rank of A for each 15. Next, the 
corresponding joint torque component, T is then evaluated from equation (2.9). The inverse 
Fourier transforms for the feedforward inputs completes the first iteration and results in 
torques, T 1 and distributed inputs V p . Then the forward dynamic analysis is carried out to 
compute K c and C c . F in the RHS of equation (2.5) is updated and the process is repeated to 
find the new input torques and voltages. The process is stopped at the n ,h iteration if 
|| 7 '>- 7 '"-i|| 2 + \\V n -V p n ~ i \\ 2 < e, where e is some small positive constant. It may be noted that 
for slow motions the terms involving K c and C c are small relative to the other terms in equa- 
tion (2.1) and the iterations converge in a few steps [1]. 

2.4 The Algorithms for the Multi-Link Cases 

In the previous sub-section the procedure to evaluate the joint actuations of a single link 
was presented. This can be recursively extended for multi-link flexible manipulators. Algo- 
rithms are presented below for both open and closed chain multi-link mechanisms. These are 
similar to those proposed by Bayo et. al. [1]. 

Multi-Link Open Chain Case 

1. Define the nominal motion (Inverse Kinematics of rigid manipulator). 

2. For each link j, starting from the last one in the chain: 

a) Compute torque (or force) T* and distributed actuator inputs P J V 
imposing z{ = 0 (Section 2). 

b) Compute the link reaction forces R j from equilibrium. 

3. Use equation (2.1) to compute the elastic displacement and joint angles. 

4. Compute the inputs for the next link, j- 1. 

Multi-Link Closed Chain Case 

1. Define the nominal motion (Inverse Kinematics of rigid robot). 

2. Define an independent set of joint forces and reactions equal in number to the degrees of 
freedom of the robot. 

3. For each link j , starting from the last one in the chain: 
a) Compute torque (or force) T j and distributed actuator 
inputs P{ imposing z/ = 0 (Section 2). 
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b) Compute the link reaction forces /?-' from equilibrium. 

4. Use equation (2.1) to compute the elastic displacements and joint angles 

5. Use elastic deflections to correct the nominal motion of each link. 

6. Repeat steps 3 to 5 until convergence in the forces/torques is obtained. 

This concludes the methodology. In the next section we present an application to a two- 
link flexible manipulator. 

3. Example 

A twolink truss experiment under development at UCSB is shown in figure 2. The trusses 
are made of lexan and have lumped masses (net 2 Kg for each link) distributed along their 
lengths. The first and the second links are tip loaded with 3.5 and 1 Kg respectively. 
Equivalent beam properties of the trusses used in the FEM model for simulations are Youngs 
modulus = 7 e 9 GPa, Link length = 1.2 m, density = 1500 Kglm 3 , cross sectional area = 
4.378 e~ 5 m 2 and cross sectional area moment of inertia = 4.7244 e~ 9 m 4 . Of the 10 spans in 
each link, two are piezo-electrically actuated. They are located at the second and ninth spans as 
shown in the figure 2. The piezo-electric stack actuators in those spans have the following pro- 
perties. Cross sectional area, A cs = 7.3 e -6 m 2 , piezo strain to voltage constant, d sv = .731 
e -6 y-\ ' youngs modulus, E p = 73 e 9 Gpa and distance of the actuator from the neutral axis 
of the truss, d, = 1.27 e~ 2 m. Following the standard Bemoulli-Eulcr modeling for an applied 
voltage V inpul , the piezo-electric actuation can be considered as two concentrated moments M 
acting at the two ends of the actuator [9] and [10]. Where M is given by 

M =(d sv N p E p A cs d t )V inpul (3.1) 

and N p = 4 is the number of piezos in each span. For the truss considered above 
M = = 0.0198V inpu/ . The desired trajectory is a rest to rest motion of the structure with initial 
conditions given by 0j = 02 = 0 and final conditions 0 t = 11.25° and 02 = —22.5°. 0s are 
the absolute angles of the links with respect to a frame fixed on the ground and are shown 
in figure 2. The nominal motion of the tip for each link are the trajectories followed by the tips 
of the links if the structure were rigid and followed the nominal angular motions shown in 
figure 3. Using the procedure in section 2.4 for open-chain mechanisms, open loop simulations 
were performed (1) using only the joint actuation for feedforward and (2) using the distributed 
piezo-electric actuators along with joint actuators in feedforward and the results arc presented 
below. 

Plots of the input piezo voltages and joint torques arc presented in figures 4 and 5 respectively. 
To illustrate the viability of the proposed method figures 6 and 7 show the transverse structural 
midpoint deflections of the two links during the motion with and without the distributed actua- 
tors. Similar plots for the elastic hub rotations are shown in figures 8 and 9. 

Thus the piezo-electric actuators show a significant reduction in the structural vibrations and 
demonstrate the viability of the proposed method. The consequent reduction in the induced 
strains in the structure allows the use of lighter elements and smaller actuators, especially in 
space structures where the loads are mainly inertial. 
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4. Conclusion 

Typically distributed actuators like the piezo-electric ones cannot gamer enough actuation 
to cause large motions in the structure. However they could be very effective in controlling the 
small structural deformations in the structure. Their use in the feedforward to aid the joint 
actuators for trajectory tracking is a novel idea developed in this paper. The method proposed 
was shown to be extremely efficient in removing structural vibrations from structures as seen 
in the example. Thus these feedforward actuations, obtained through the proposed inverse 
dynamics, augmented with joint angle feedback based closed loop controllers seem promising 
in the slewing control of flexible manipulators. This encouraging result motivates further work 
on distributed actuators in the control of flexible structures. 
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Figure 2. The Tmo Link Truss Structure 
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Fig. 3: nominal angular positions 
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Piezo Input Voltages (V) 
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Fig. 4: input piezo voltages 
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Fig. 5: inverse dynamics torques 
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Fig. 8: elastic hub rotation of link 1 
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Fig. 9: elastic hub rotation of link 2 


103 





